#include "motor_task.h"

int speed_set=50,dir=0;

void Motor_task(void const * argument)
{
    Motor_init();
    while (1)
    {
        //motor_speed_set(0,dir,speed_set);
        ang_to_enc();
		motor_pos_set();
        encoder_read();
        osDelay(1);
    }
    
}
